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® BACK-LASH ACCELERATION CONTROL METHOD. 



® A method for starting back-lash correction at an optinum point ahead of a predetermined time from the point 
of reversal of a speed command without being affected by a feed speed, etc. A moving command of one 
previous cycle is subtracted from a moving command of one preceding cycle with respect to a distribution cycle 
to determine accelaration in this distribution cycle, and the absolute value of the sum is multiplied by a constant 
K which is determined by the frictional force of a machine and the product is stored in a register A, When the 
speed command corrected by a feed-forward quantity FF at the time of reversal of the moving command 
reaches the memory value of the register A (S18, S19), back-lash acceleration correction is started. In this way 
back-lash correction is started from a predetermined time before the reversal point of the sign of the speed 
command. 
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Technical Field 

This invention relates to a method of controlling a servomotor for actuating a table of a machine tool, a 
robot arm or the like, more particularly to a backlash acceleration correction to be executed when the 
5 moving direction of the table or robot arm is reversed. 

Background Art 

In reversing the rotating direction of a servomotor for actuating a table feed shaft of a machine tool, a 

10 robot arm or the like, driven parts of the machine cannot be reversed at once due to the effects of the 
friction and the backlash of a feed screw or reduction gear. Thus, if the rotating direction of the servomotor 
is reversed while contouring operation is carried out with the machine tool or the robot arm is making 
circular movement, a swell is formed in the cut surface of a workplece or in the locus of the robot arm. 

For example, in the case of a circular cutting performed on a workpiece in a plane defined by two axes, 

75 i.e., X and Y axes, when driven to move from a state of the movement of which the X component and Y 
component are negative and positive respectively into another state of the movement of which both the X 
and Y components are negative, causing a transition from one quadrant to another, the cutting speed with 
respect to the Y axis remains the sanne, but, for the movement in the direction of the X axis, the position 
deviation becomes "0", and thus the torque command value becomes smaller. Since the rotation of the 

20 servomotor cannot be reversed at once due to friction and the movement of the table cannot be reversed at 
once due to the backlash of the feed screw for feeding the table, the movement of the workplece in the X- 
axis direction will not be able to respond to the move command at once, thereby causing the delay of 
action. As a result, a swell will be formed on the circular surface to be cut. 

To eliminate or lessen such a swell, the so-called backlash acceleration is applied, as disclosed In, e.g., 

26 Unexamined Japanese Patent Publication JP-A-4-8451. In which, when the moving direction Is reversed, 
position backlash correction is carried out on a position deviation, and when the position deviation is 
reversed, an appropriate value (acceleration value) is added to a velocity command to accelerate the 
servomotor in the reverse direction, thereby reducing a swell caused by quadrant change. 

Further, in servomotor systems for machine tools, feedforward control is employed to reduce the 

30 amount of position deviation. Especially, in carrying out high-speed cutting with a machine tool, a shaping 
error occurs due to a follow-up delay of the servo system. To lessen the shaping error, a feedforward 
control method has been developed, as proposed by the applicant of the present application in International 
Patent Application No. PCT/JP9 1/01 537, in which a smoothing processing is executed on a move command 
output from a numerical control device to obtain a feedfonward quantity; the feedforward quantity is then 

36 added to a velocity command from a position loop, which is obtained by multiplying the position deviation 
by a position gain, to obtain a corrected velocity command, and the processing of a velocity loop is 
executed by using the corrected velocity command. 

This type of feedforward control will be described with reference to Fig. 4. A DDA (digital differential 
analyzer) 10 divides a move command Mcmd. which is outputted from a CNC (computer numerical control) 

40 device in every distribution period, into move commands for respective positionA/elocity loop processing 
periods. An error counter 1 1 adds up the values obtained by subtracting a position feedback quantity Pfb 
from the move command outputs delivered by the DDA 10 to obtain a position deviation. An element 12 
calculates a velocity command by multiplying a position gain Kp by the position deviation stored in the error 
counter 11. Reference numeral 13 denotes a velocity loop term, In which a velocity loop processing is 

45 executed based on the velocity command to obtain a torque command in a conventional manner, and a 
servomotor is driven in accordance with the torque command. Reference numeral 14 denotes an integral 
term, in which the velocity of the servomotor is integrated to obtain a servomotor position. Lead module 15 
is a term for carrying out feedforward control and advances the move command, an output from the DDA 
10, by a period d of the positionA/elocity loop processing period. A smoothing circuit 16 computes a mean 

50 value, and a terrn 17 is for obtaining a feedforward quantity by multiplying the output value of the smoothing 
processing by a feedforward coefficient a. 

The feedfoPArard quantity is then added to the velocity command, which is obtained by multiplying the 
position deviation by the position gain Kp, to obtain a velocity command Vcmd corrected through the 
feedforward control, and the processing of the velocity loop is executed by using thus obtained velocity 

55 command Vcmd. 

In controlling a servomotor with the servo system described above, if the feedforward coefficient a is 
close to "1," most part of the velocity command Vcmd derives from the feedforward control, and the 
position deviation becomes nearly "0". Further, since the phase of the feedforward-based command is 
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advanced, the phase of the position deviation* will be delayed. If the feedforward coefficient a is close to 
"1," the delay of the motor position with respect to the move command becomes almost zero. Con- 
sequently, it is difficult to determine based on the position deviation the time for the backlash acceleration 
correction coinciding with the time of reversal of the moving direction due to that the position deviation is 

5 nearly "0" and due to the phase lag. Further, since the delay of the actuaf motor position with respect to the 
move command is nearly zero, and the distribution period of the CNC is relatively long (usually, the 
distribution period is longer than the position/velocity loop processing period), if the backlash acceleration 
correction is initiated at the time of reversal of the position deviation, the time for initiating the backlash 
acceleration correction is subject to variation because of difference In the start position of a machining 

10 program. 

Also, as for this type of feedforward control, the applicant of the present application has proposed a 
backlash acceleration control method for reducing the swell occurring due to the quadrant change In 
International Patent Application No. PCT/JP92/00666. In this method, the backlash acceleration correction Is 
initiated when the feedforward quantity changes from positive to negative or vice versa, or when the velocity 
76 command obtained by adding the feedforward quantity to the product of the position deviation and the 
position gain changes from positive to negative or vice versa. Even with this method, the backlash 
acceleration correction will not work effectively in the case of high-speed movement along a circle with a 
small radius. 

20 Disclosure of the Invention 

An object of this invention is to provide a method for effectively carrying out backlash acceleration 
correction by initiating it at a predetermined time before an actual reversal of direction, without regard to 
various conditions such as velocity, circle radius or the like. 
25 The method according to this invention comprises the steps of: obtaining an acceleration according to 
move commands when the direction of a move command of a present period and the direction of a move 
command of a subsequent period are In a reverse relationship; and initiating a backlash acceleration 
correction at an instant when a value proportional to the acceleration coincides with the value according to a 
velocity command. 

30 

Brief Description of the Drawings 

Fig. 1 is a flowchart of a processing executed by a processor of a digital servo circuit in each distribution 

period in executing feedforward and backlash acceleration correction according to this Invention; 
35 Hg. 2 is a part of a flowchart of a feedforward and backlash acceleration correction processing, which is 

executed by the processor of the digital servo circuit In each position/velocity loop processing period; 

Fig. 3 is the remainder part of the flowchart shown in Fig. 2; 

Fig. 4 is a block diagram of a servo system for executing feedforward control; 

Fig. 5 is a block diagram showing a principal part of servomotor control for executing this invention; 
40 Fig. 6 is a diagram illustrating the operation principle of this invention; 

Fig. 7 is a diagram illustrating move commands in the X-axis direction shown in Fig. 6; and 

Fig. 8 is a graph showing a point of time at which the backlash acceleration correction Is initiated. 

Best Mode of Carrying Out the Invention 

45 

Referring first to Figs. 6 to 8, the operation principle of this invention will be explained. In Fig. 6. a move 
command of an immediately preceding distribution period is indicated by a vector M2. a move command of 
a present distribution period by a vector Ml, and a move command of a subsequent distribution period by a 
vector MO, where it is assumed that a circular movement is under way. In this case, the X-axis components 

50 (move commands for a servomotor of the X axis) of the vectors MO, M1 and M2 are represented by MOx, 
Mix and M2x, respectively. Assuming that the move commands are distributed as shown in Fig. 7, the 
absolute value of an acceleration in the X-axis direction at the start point a of the present period can be 
obtained by calculating jMOx - M2xi. 

Provided that the radius of the circle is R (mm) and the feed rate is F (mm/min), an angle A$ over 

56 which the movement progresses during one distribution period Ts (sec) can be expressed as 

AO = F-Ts/(60R) (rad) 
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Further, since 

MOx = R{cos(eo + A6) - COS0O} 
M2x = R{cos(fio - Ae) - cos(fio - 2A0)} 
5 where -A6/2 < $o < Ae, 

the acceleration AV can be given as 

AV = IMOx - M2xl 

70 

= 4R- sin(A0/2) - sinA^ • cos{0o - 
(Aa/2)} 

75 Assuming that the value Ae is very small relative to "1". sin(A0/2), sinAG and cos{0o - (Ae/2)} can 
respectively be approxinnated to A0/2, A0. and "1". Thus, the acceleration AV can be given as 

AV = IMOx - M2xl 

= (2/R) • (F • Ts/60) 2 (mm) (1) 

On the other hand, the move command x{t) in the X-axis direction is expressed as 
26 x(t) = R . cos{F. t/(60R)} 

where t represents time, and it Is assumed that the moving direction Is reversed when t = 0. 
The velocity command Vx(t) is obtained by differentiating the move command x(t) as follows: 

30 

Vx(t) = (d/dt)x(t) 

= -R- {F/(60R)} - sin{F • t/{60R) } 

35 Thus, in the proximity of t = 0 at which the direction is reversed. sin{F« V(60R)} can be approximated 
to (F • t/60R), and the velocity command Vx(t) can therefore be expressed as follows: 

Vx(t) = -(1/R) - (F/60) 2. t 

40 Accordingly, if the backlash acceleration correction is initiated at a point of time when the velocity 
command Vx(t) becomes equal to the product of the acceleration AV and a constant K, which is dependent 
on the friction, as shown in Fig. 8. then 

Vx(t) = K . AV (2) 

45 

Therefore, 

-(l/R) . (F/60)2. t = K . (2/R) • (F • Ts/60)2, 
50 namely, 
t = -2KTs2. 

Thus, the time for initiating the backlash acceleration correction, t = -2KTs2. becomes no longer dependent 
65 upon the radius R and the feed velocity F, and the acceleration start time becomes constant. 

Referring now to Fig. 5, a servomotor control device for a machine tool or robot, to which the method 
according to this invention is applied, will be described. In Fig. 5. various commands for a servomotor 24, 
outputted from a CNC device 20, are transferred to a processor of a digital servo circuit 22 via a common 
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memory 21 . The digital servo circuit 22 comprises a CPU, a ROM, a RAM. etc., and the CPU controls the 
position, velocity and current of the servomotor 24. A servo amplifier 23 comprises a transistor inverter etc., 
and drives the servomotor 24. A pulse coder 25 detects the rotational position of the servomotor 24, and 
feeds the detected position back to the digital servo circuit 22. 

5 Figs. 1, 2 and 3 are flowcharts of a feedforward processing and backlash acceleration correction 

executed by the CPU of the digital servo circuit 22. Fig. 1 shows a processing executed in every distribution 
period, and Figs. 2 and 3 show the feedforward processing and backlash acceleration correction executed 
in every position/velocity loop processing period. Description of the processings other than the feedforward 
processing and the backlash acceleration correction are omitted here, since they are similar to conventional 

10 ones. 

First, whether or not the feedforward control should be rendered effective is set by means of the CNC 
device 20 in accordance with a machining operation to be carried out, and upon start of the operation, the 
CPU of the digital servo circuit 22 executes the processing shown in Fig. 1 in every distribution period. 

First, in Step SI. the move command for a distribution period immediately preceding (one period 

76 before) a present distribution period, stored in a register R1, Is loaded in a register R2, and the move 
command for the present distribution period (the period in which the move command for executing the 
position/velocity loop is outputted), stored in a register RO, is loaded in the register R1. 

Then, in Step S2, a move command Mcmd for a subsequent distribution period (one distribution period 
after that in which the position/velocity loop processing is executed) is read and stored in the register RO. 

20 In Step S3, it is determined whether or not the move command Mcmd of the subsequent period, stored 
in the register RO, is "0"; if the move command Mcmd is "0", the program proceeds to Step S8 described 
later, and if the move command Mcmd is not "0", the program proceeds to Step S4. In Step S4, the 
product of the move command Mcmd, read in the present period and stored in the register RO, and the 
move command which has been read one period before the present period and stored in a register Rz. is 

26 obtained,' and it is then determined whether or not the obtained product is negative. That is. it is determined 
whether or not there has been a change in the sign, from positive to negative or vice versa, between the 
move command Mcmd of the subsequent period and the move command for the present position/velocity 
loop processing. The register Rz is first set to "0" by Initialization. 

If the above product is negative, a flag F1 is set to "1 " to indicate that sign of the subsequent move 

30 command will be reversed, in Step S5, and then in Step S6, the move command of the subsequent period, 
stored in the register RO, is loaded in the register Rz. 

In Step S7, the absolute value of a difference obtained by subtracting the move command of the 
subsequent period, stored In the register RO, from the move command of the preceding period, stored in 
the register R2, is multiplied by a preset constant K (which is set in advance in accordance with the friction 

35 of the machine), and the value obtained Is stored in a register A. More specifically, the calculation of the 
aforementioned expression (1) is carried out to obtain an acceleration AV, and the product of the 
acceleration and the constant K is stored in the register A. Finally, in Step S8, a counter C is set to "0", and 
the processing for the present distribution period is ended. 

If the product obtained in Step S4 is not negative (if there has been no change of sign between the 

40 move commands concerned), the program proceeds from Step S4 to Step S9, without setting the flag F1 to 
"1," and the move command of the subsequent period, stored in the register RO, is loaded in the register 
Rz. Finally, in Step S8, the counter C is set to "0". and the processing for the present period will be ended. 

The CPU of the digital servo circuit executes the above-described processing at intervals of the 
distribution period, whereby the registers R2, R1 and RO are successively loaded with a move command of 

46 the immediately preceding period, a move command of the period for executing the position/velocity loop 
processing, and a move command of the subsequent period, respectively, and the flag F1 is set to "1 " in 
the case of a reversal of the sign of the move command Mcmd. 

The CPU of the digital servo circuit also executes the processing shown in Figs. 2 and 3 at intervals of 
the position/velocity loop processing period. 

60 In Step SlO, it will be judged whether or not rendering the feedforward processing effective has been 
preset. If the feedforward processing has been rendered effective, it is determined in Step S1 1 whether or 
not the value of the counter C registers a value smaller than or equal to 1/2 of the value N obtained by 
dividing the distribution period by the position/velocity loop processing period, i.e., N = (distribution 
period)/(position/velocity loop processing period). If the value of the counter C is smaller than or equal to 

66 N/2, a value obtained by subtracting the value in the register R2 from the value in the register R1 is added 
to the value in an accumulator SUM in Step Si 2. and the program proceeds to Step Si 4. If the value of the 
counter C is greater than N/2, a value obtained by subtracting the value In the register R1 from the value In 
the register RO Is added to the value in the accumulator SUM, in Step 813, and the program proceeds to 
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Step S14. At first, the accumulator SUM is set to "0" by initialization. 

In Step S14, a value obtained by dividing the value of the accumulator SUM by the square of the 
above-mentioned value N is multiplied by a feedforvsrard coefficient a to obtain a feedforv^ard quantity FF, 
which will be then outputted. More specifically, the feedforward quantity FF is added to a value, which is 

5 obtained by multiplying the position deviation by a position gain Kp as in an ordinary position loop 
processing, to obtain a velocity command Vcmd corrected by the feedforward quantity FF, and a velocity 
loop processing similar to a conventional one will be executed by using the thus-corrected velocity 
command Vcmd. Then, in Step SI 5, "1 " is added to the value in the counter C. 

The aforementioned Steps S11 to Si 5 constitute the processing for obtaining the feedforward quantity 

70 FF. It is to be noted that this embodiment is concerned with a case where the quantity of advance 
implemented by the lead module 15 in the feedforward processing is set to 1/2 of the distribution period, 
and this type of feedforward processing is described in detail in International Patent Application No. 
PCT/JP92/00666 mentioned above. 

Subsequently, in Step Si 6, it is determined whether or not the flag F1 is "1." If the flag F1 has not 

76 been set to "1 " in Step S5 (if there is no change of sign between the move commands concerned), the 
program proceeds from Step S16 to Step S21, whereupon it is determined whether or not a flag F2 is "1". 
If the flag F2 is not "1". it Is determined in Step S26 whether or not the value of a counter D, which 
measures a backlash acceleration time, is "0", and. if the value of the counter D is smaller than or equal to 
"0" (the value of the counter D, is "0" unless a backlash acceleration command has been outputted, as 

20 mentioned later), the feedforward processing and backlash processing will be ended. 

If the value in the register RO storing the subsequent move command Mcmd has a different sign from 
the move command stored in the register Rz (i.e., the move command for the present position/velocity loop 
processing), and thus the flag F1 has been set to "1" In Step S5, the program proceeds from Step SI 6 to 
Step S17, whereupon it is determined whether the reversal of the sign is from positive to negative or vice 

25 versa depending on whether the move command stored in the register RO is negative or positive. If the 
reading of the register RO is negative, it is concluded that the sign has changed from positive to negative, 
and the program proceeds to Step Si 8. Whereas If the value of the register RO is positive, the program 
proceeds to Step S19. 

Then, in Step 818, the product of the position deviation and the position gain Kp is added to the 
30 feedforward quantity FF calculated in Step SI 4, the product of the absolute value of the acceleration, stored 
in the register A, and the multiplier K is subtracted from the first obtained value; and it Is determined 
whether or not the result has a value equal to or smaller than "0". That is. It is determined whether or not 
the velocity command obtained by correcting the feedforward quantity has become equal to the value 
obtained in Step ST. and this determination processing corresponds to the determination by aforementioned 
35 equation (2). 

If the velocity command is not equal to the value stored In the register A, and thus it is determined in 
Step SIB that the value is greater than "0", the program proceeds to Step S21, and the above-described 
processing will be executed without initiating the backlash acceleration correction. If it is determined in Step 
SI 9 that the value obtained by adding the value of the register A to the velocity command corrected by the 

40 feedforward quantity is negative (this determination also corresponds to the equation (2), and Is applied 
when the move command has changed from negative to positive, and thus the velocity command Is first 
negative; and the backlash acceleration correction start time coincides with the point of time at which the 
sum of this velocity command and the value of the register A becomes equal to "0"), the program proceeds 
from Step Si 9 to Step S21 , and the backlash acceleration correction will not be initiated. 

45 Even in the case where the sign of the subsequent move command is reversed, the velocity command 

obtained by correcting the feedforward quantity FF will not immediately become reversed. As is clear from 
the processing in Step Si 2. the move command of which the sign is reversed will not affect the calculation 
of the feedforward quantity FF before the lapse of N/2, which is based on the position/velocity loop 
processing period and corresponds to half the distribution period. Thus, at least during the period N/2 based 

60 on the position/velocity loop processing period, neither the sign of the feedforward quantity FF not the sign 
of the velocity command obtained through correction of the feedforward quantity will be reversed. 
Consequently, the backlash acceleration correction will not be initiated. 

If, however, it is detected in Step SI 8 or SI 9 that the velocity command corrected by the feedfonward 
quantity FF has become equal to the value stored in the register A, the flag F2 is set to "1". and the flag F1 

66 is set to "0" (Step S20). The program then proceeds from Step S20 to Step S21. Since the flag F2 has 
been set to "1 the program proceeds from Step S21 to Step S22, whereupon a value Tb corresponding to 
the backlash acceleration correction time set in the counter D will be set. Then, In Step S23, the flag F2 will 
be set to "0". 

6 
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In Step S24, a set backlash acceleration correction value is outputted, whereby this backlash accelera- 
tion correction value is added to the velocity command Vcmd corrected by the feedforward quantity FF, and 
In Step S25, "1" is subtracted from the value of the counter D, followed by termination of the feedforward 
control and backlash acceleration correction control for the present period. 
5 In the subsequent position/velocity loop processing periods, since the flags F1 and F2 are both set to 

*'0". steps S11 to Si 5. Si 6 and S21 will be executed, and the program proceeds to Step S26. Then. Steps 
S24 and S25 for the backlash acceleration correction will be until the value of the counter D becomes "0", 
i.e., until the set backlash acceleration correction time elapses. After the value of the counter D has become 
"0", the backlash acceleration correction will not be carried out thereafter. 

70 When the presetting for invalidating the feedforward processing has been made, the program proceeds 
from Step S10 to Step S27. whereupon the feedforward quantity FF is set to "0". The program then 
proceeds to Step Si 6 to execute Step SI 6 and the steps subsequent thereto, and in this case, the 
feedforward processing in Steps S11 to S15 will not be carried out. 

While the above-described processing is repeated, the backlash acceleration correction is started at a 

76 point of time when the value dependent on the machine's frictional force proportional to the acceleration 
according to a command whose direction is reversed becomes coincident with the value according to the 
velocity command, whereby the backlash acceleration correction can be Initiated accurately at a fixed time 
preceding the reversal of direction. Thus, the backlash acceleration correction effectively works even in the 
case of high-speed movement along a circle with a small radius, without regard to the circle radius or the 

20 feed velocity commanded by move commands. 

Claims 

1. A backlash acceleration control method designed to be applicable when a direction of movement of a 
25 machine driven by a servomotor is reversed, comprising the steps of: 

obtaining an acceleration of the move command at a time when the direction of a move command 
of a present period and the direction of a move command of a subsequent period are in a reverse 
relationship; and 

initiating a backlash acceleration correction at a point of time when a value proportional to said 
30 acceleration coincides with a velocity command. 

2, A backlash acceleration control method designed to be applicable when a direction of movement of a 
machine driven by a servomotor is reversed, comprising the steps of: 

obtaining a feedforward quantity by executing a smoothing processing for obtaining a mean value 
35 of move commands for a plurality of position/velocity loop processing periods which include a present 

period and several periods before and after the present period; 

obtaining a velocity command corrected by said feedforward quantity, and controlling the ser- 
vomotor in accordance with the corrected velocity command; 

obtaining acceleration of the move command when the direction of the move command of the 
40 present period and the direction of the move command of the subsequent period are in a reverse 

relationship; and 

initiating a backlash acceleration correction at a point of time when a value proportional to the 
acceleration of move command coincides with the corrected velocity command. 

45 3. A backlash acceleration control method according to claim 2, wherein the smoothing processing 
comprises obtaining a mean value of move commands for pluralities of position/velocity loop process- 
ing periods that includes a present period and several periods before and after the present period and 
further of which number corresponds to the distribution period. 

50 4. A backlash acceleration control method according to claim 3, wherein the feedforward quantity is 
obtained by multiplying a feedforward coefficient by the mean value of move commands obtained by 
the smoothing processing. 
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